int8 robotID
PoseMst[] poseMstPair
vector7d[] map_of_labelXYZ
interRobotTF[] interRobotTFs